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Abstract 

This  study  took  a  previously  developed  six  state  Kalman 
filter  (designed  for  space-based  tracking  of  a  hypersonic 
transatmospheric  vehicle),  tuned  it,  and  performed  a  Monte 
Carlo  analysis.  Three  multiple  model  adaptive  filters  were 
then  developed,  with  sub-filters  designed  for  quiescent 
periods  and  periods  with  apparent  acceleration.  Next,  a 
smoother  was  developed  using  the  six  state  filter  as  the 
forward  filter  and  a  form  of  that  same  filter  as  the 
backward  filter.  The  smoother  and  all  of  the  above  filters 
were  compared  for  their  ability  to  most  accurately  estimate 
the  transatmospheric  vehicle’s  state,  with  special  emphasis 
on  the  acceleration  states.  This  emphasis  was  motivated  by 
a  desire  to  evaluate  the  Kalman  filter's  usefulness  as  a 
real-time  intelligence  gathering  tool.  From  the  data 
generated,  it  was  concluded  that  neither  the  adaptive 
filters  nor  the  smoother  improved  upon  the  performance  of 
the  six  state  Kalman  filter. 
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ADAPTIVE  FILTERING  AND  SMOOTHING  FOR  TRACKING 
A  HYPERSONIC  AIRCRAFT  FROM  A  SPACE  PLATFORM 


I .  Introduction 


The  transatmospheric  vehicle  (TAV)  is  envisioned  as  an 
air-breathing,  horizontal  take  off,  hypersonic  craft  capable 
of  using  aircraft-style  flight  to  ascend  to  and  descend  from 
orbit.  The  TAV  is  seen  as  the  next  step  in  the  evolution  of 
surf ace-to-orbit  travel . 

The  infrared  signature  from  air  friction  on  the  TAV,  as 
well  as  the  signature  from  its  necessarily  hot  and  powerful 
engines,  should  be  a  brilliant  point  source  even  when  viewed 
from  geosynchronous  orbit.  Thus  the  very  nature  of  the  TAV, 
its  hypersonic  speed,  will  readily  betray  its  position  to 
virtually  any  orbital,  infrared-sensing  platform.  That  same 
speed  would  render  conventional  aircraft  tracking  useless. 

A  tracking  algorithm  using  data  from  orbital  sensors  would 
allow  continuous  tracking  in  the  event  of  telemetry  loss,  in 
the  case  of  enemy/non-broadcasting  TAVs,  and  when,  for 
national  security  reasons,  the  TAV  does  not  wish  to 
advertise  its  position  through  its  transponder. 

Objectives 

This  thesis  refines  a  previously  developed  TAV  tracking 
algorithm  (Ziegler),  and  builds  upon  that  work.  The  primary 
objective  is  to  estimate  the  TAV’s  position,  heading, 
velocity,  and  acceleration  with  minimal  errors.  A  secondary 
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objective  is  to  compare  the  performance  characteristics  of  a 
basic  Kalman  filter,  three  different  multiple-model  adaptive 
Kalman  filters,  and  a  smoother,  when  applied  to  the  problem 
of  estimating  TAV  state. 

Approach 

To  properly  develop  the  above  filters,  this  thesis  will 
model  TAV  dynamics,  as  well  as  data  collection  and 
processing.  Ziegler’s  six  state  Kalman  filter  will  be 
refined  and  subjected  to  a  Monte  Carlo  analysis  to  allow 
accurate  filter  tuning.  Next,  a  reduced  order,  four  state 
filter  will  be  designed  with  the  intention  of  better 
modeling  periods  without  accelerations,  and  this  filter  will 
be  integrated  with  the  six  state  filter  as  the  two 
sub-filters  in  various  multiple-model  adaptive  filter 
algorithms.  Finally,  a  smoother  will  be  evaluated  as  an 
off-line  alternative  for  estimating  the  TAV’s  state. 

Overview 

A  geosynchronous  infrared  sensor  of  known  accuracy  will 
supply  position  data  to  the  various  filters.  The  sensor 
data  will  be  preprocessed  into  longitude  and  latitude,  and 
the  filters  will  utilize  these  position  "measurements”  to 
estimate  the  TAV's  state. 

The  TAV  is  assumed  to  be  a  brilliant,  "...isotropically 
radiating  point  source  operating  in  the  outer  fringes  of  an 
atmosphere  surrounding  a  perfectly  spherical  and  rotating 
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earth."  (6:1-3)  This  thesis  will  ignore  the  altitude  state 
because  r  «  r  when  observed  from  a 

TAV  earth 

orbital 

geostationary  orbit. 
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II.  Vehicle  Dynamics  (6:2-1  through  2-10) 


A  dynamics  truth  model  is  essential  in  properly 
evaluating  Kalman  filter  performance.  The  truth  model 
states  must  be  compared  to  the  filter's  estimates  to  be  sure 
the  filter  is  properly  estimating  those  states.  For  this 
thesis,  a  truth  model  that  ignores  altitude  is  believed  to 
be  adequate  since  the  radius  of  a  low  earth  orbit  is  so 
close  in  magnitude  to  the  earth’s  radius.  This  section 
derives  the  equations  of  motion  for  the  transatmospheric 
vehicle  under  the  above  assumption. 

State  Variabl es 

Six  state  variables  have  been  chosen  to  represent  the 
TAV's  overall  state.  Earth  longitude,  is  defined 
positive  east  of  the  Greenwich  Meridian,  and  negative 
westward.  Earth  latitude,  6,  is  defined  as  positive  north 
of  the  equator,  and  negative  southward.  Heading,  h,  is  the 
clockwise  angle  from  the  true  north  direction  to  the  current 
direction  of  travel.  Velocity  is  the  speed  along  the 
current  direction  of  travel  (and,  by  definition,  there's  no 
component  of  velocity  out  of  the  direction  of  travel). 
Intrack  acceleration,  a^  is  the  rate  of  change  in  speed 
along  the  direction  of  travel.  Transverse  acceleration,  aT, 
is  the  rate  of  change  in  velocity  along  the  line  out  the 
left  wing  of  the  TAV  (perpendicular  to  the  current  direction 
of  travel ) . 
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(2.1) 


( a  5 /  |  a i | )  x  (aT/|aTj)  =  (local  zenith) 


Equations  of  Motion 

To  find  velocity,  basic  dynamics  states 

V  =  w- r  (2.2) 

where  r  is  the  radius  and  u  is  the  angular  rate.  From  this 
the  TAV  velocity  can  be  stated 


t  a  v 


v.l 

r  oO 

R  -cos  6 

X 

X 

A 

K 

Ur 

l  5J 

R 

l  •  J 

(2.3) 


where  is  the  angular  rate  of  change  in  the  longitudinal 

direction,  and  u,  is  the  angular  rate  of  change  in  the 

o 

latitudinal  direction.  Over  a  sufficiently  small  period  of 
time,  this  spherical  geometry  problem  about  the  earth  can  be 
approximated  by  planar  geometry 


Figure  2.1  Planar  Representation  of  TAV  Motion 
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Call  this  small  period  of  time  dt  and  Equation  (2.3)  becomes 


V  -sin  h 
ta  v 

V  • cos  h 

T  AV 


(dx/dt) -R  -cos  6 
( d6/dt ) • R 


(2.4) 


Solving  for  X  and  S 


j')  V  -sin  h  /cos  6 

X  =  ( 1/R  )•  TAV 
£  *  V  cos  h 

7  IAV 


Correcting  for  the  earth's  rotation 


(V  sin  h)/(R  -cos  6)  -  w 

TAV  •  i 

(V  -cos  h)/R 

TAV  e 


(2.5) 


(2.6) 


To  find  h  and  V,  define  the  ENZ  frame  such  that 

E  =  local  eastward  direction  at  TAV  location 
N  =  local  northward  direction  at  TAV  location 
Z  =  E  x  N  (6:2-6) 

and  the  b-frame  (body  frame)  such  that 


B  =  a  /la  I 

1  i  i 

B  =  a  / la  I 

2  T  T 

B  =  B  x  B 

3  12 


(6:2-6) 
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Figure  2.2.  TAV  Coordinate  Frames  (6:2-6) 


E  =  sin  h  B  -  cos  h  B 
1  2 


N  =  cos  h  B  +  sin  h  B 

1  2 


Z  =  B 


Inertial  acceleration,  as  a  function  of  inertial 
velocity,  expressed  in  the  body  frame  is 


dD 

/  77  \  .  7T  b  i  _  rrb 


3D  =  ^(V)  +  u  01  X  V 


^(V  B  )  +  5  61  X  V* 


=  V  B  +  o  bl  x  (V  B  ) 

1  l 


with 


-  bi  _  -  b ,  E  N  Z  ,  -  E  N  Z ,  i 

u  =  (i)  +  u 
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where 


cj  b  1  =  angular  rotation  of  the  body  frame 
with  respect  to  the  inertial  frame 
<i)  ’  =  angular  rotation  of  body  frame  with 

respect  to  ENZ-frame 

-  E*z,i  _  angujar  rotation  of  ENZ  frame  with 
respect  to  inertial  frame 


Prom  Figure  2.2 

u  b'E"z  =  -h  B3  (2.10) 


Since  the  ENZ 

-frame  motion  is  dependent  upon  TAV 

and 

earth 

motion , 

—  E  X  2  ,  i  -  .  - 

CJ  =  CJ  +  CO 

•  TAV 

(2.11a) 

=  <0  +  X  +  S 

e 

(2.11b) 

=  <o  +  X-cos  5  N  -  5 

• 

E 

+  X-sin  8  Z 

(2.11c) 

where 

u  =io  -cos  8  N  +  <o  -sin  8  Z 

•  ®  8 

(2. lid) 

Expressed  in 

the  body  frame  this  becomes 

-  EKZ,  i 
CJ 

=  ^-6-sin  h  +  (x  +  u  )-cos  5  •  cos  hj 

B 

1 

+  |i'COS  h  +  (X  +  co  )-cos  8  •  cos  hj 

1  B 

1  2 

+  (X  +  u  ) -sin  8  B 

8  3 

(2.12) 

therefore 

-  b  ,  i 

<o 

A  A  A 

=  (o  B  +  w  B  +  <o  B 

1  1  2  2  3  3 

(2.13) 

where 

o 

i 

=  -6-sin  h  +  (X  +  u  )-cos  6  ■  cos  h 

• 

w 

2 

=  $cos  h  +  (X  +  w  )-cos  6  •  cos  h 

A 

<i> 

=  (X  +  cj  )  -sin  6  -h 

3  e 
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Substituting  Equation  (2.13)  into  Equation  (2.8)  gives 


A  =  V  B  + 
1 


B 


u> 


B, 

4 

<l) 


B 


u 


(2.14a) 


where  |*|  indicates  a  cross  product.  This  becomes 

X  =  V  B  +  V  u  B  +  V-u  B 

1  3  2  2  3 


(2.14b) 


Neglecting  the  B^  term  in  the  previously  assumed  negligible 


altitude  direction  gives 

A  = 

Now,  substituting  X  from  Equation  (2.6) 


=  V  +  V-£(x  +  ua)-sin  6  -  hj  Bz  (2.14c) 


-sin  Ik 

-4^ — jJ 

R  -cos  6  J 


cos-5-]  sin  6  ■  v  hr  b2 


( 2 . I4d ) 


but 


aj  =  B^  component  of  inertial  acceleration 
a  =  B  component  of  inertial  acceleration 

T  2 


therefore 


a  =  V 

i 


V  -sin  h  -sin  5 


a  = 

T 


-  V-fl 


~ R  • cos  <$ 

Solving  these  equations  for  V  and  h  gives 
V  =  a 


(2.15) 

(2.16) 


(2.17) 

(2.18) 

Finally,  since  changes  in  acceleration  have  no  deterministic 


h  =  -a  /V  +  (V-sin  h  -sin  5  )/(R  -cos  6) 

T  • 


model,  impulsive  changes  in  acceleration  were  assumed  and 
the  rates  of  change  for  acceleration  were  set  to  zero. 

a,  =  aT  =  0  (2.19) 


2-6 


Summarizing  Equations  (2.6),  (2.17),  (2.18),  and  (2.19) 


gives 


■ 

-  * 

X 

(V-sin  h)/(R  -cos  6)  -  u 

•  0 

5 

(V-cos  h)/R 

• 

1 i 

-a  /R  +  (V-sin  h  -sin  6)/(R  -cos  6) 

r 

T  e  • 

V 

a 

i 

a 

0 

i 

a 

L  tj 

0 

Propagating  the  Truth  Model  (6:2-10) 

The  six  equations  of  motion  are  first  order 
differential  equations  of  the  form  x  =  f(x,t).  Given  the 
initial  conditions.  Equation  (2.20)  can  be  numerically 
integrated  to  give  a  time  history  of  the  truth  model  states. 

For  this  thesis,  the  Hamming  predictor-corrector  method 
was  used  as  the  numerical  integrator.  "Given  initial 
conditions,  the  time  step  size,  and  the  right  hand  side  of 
the  equations  of  motion,  the  Hamming  algorithm  produced 
detailed  time  histories  for  X,  8,  h,  V,  a  ,  and  a  . " 

I  T 

(6:2-10)  For  all  calculations,  units  of  angles  were 
radians,  units  of  velocity  were  DU/TU,  and  units  of 
acceleration  were  DU/TU2.  One  DU  is  the  average  equatorial 
radius  of  the  earth,  about  6378.145  kilometers.  One  TU  is 
approximately  806.8  seconds,  resulting  in  one  gravity  (G) 
equaling  one  DU/TU2. 
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Ill . 


Sensor  (6:3-1  through  3-9) 


This  chapter  deals  wich  the  collection  and  processing 
of  the  raw  data  from  the  geosynchronous  sensor.  Ziegler's 
technique  of  preprocessing  the  data  has  been  retained  due  to 
its  simplifying  effect  on  the  Kalman  filter  algorithms. 

Raw  Data 

The  geosynchronous  satellite  carrying  the  sensor,  by 
the  nature  of  its  orbit,  remains  at  a  constant  longitude  and 
latitude.  For  this  thesis,  the  sensor  has  been  placed  at  0° 
longitude  and  0°  latitude.  The  thermal  emissions  of  the  TAV 
are  located  in  the  sensor's  field  of  view  via  azimuth  (Az) 
and  elevation  (El)  as  shown  in  Figure  3.1. 

Azimuth  is  the  spherical  angle  from  the  northward 
direction  to  the  great  circle  containing  the  TAV.  Elevation 
is  the  angle  seen  by  the  sensor  from  the  nadir  to  the  TAV  as 
shown  in  Figure  3.2.  From  the  geometry,  0  <  El  <  8.6°. 
(6:3-2) 

Another  component  of  the  raw  data  is  the  uncertainty 
associated  with  each  measurement.  No  measurement  is  exact; 
each  one  has  error  due  to  uncertainties  in  sensor  position, 
sensor  attitude,  atmospheric  effects,  vibrations,  etc. 
(6:3-2)  According  to  the  central  limit  theorem,  these  error 
sources,  when  summed  together,  become  zero-mean,  Gaussian 
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Figure  3.2.  Planar  View  of  Elevation 
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random  variables.  This  thesis  will  carry  forward  the 
standard  deviations  (o)  of  3.5xl0~s  radians  for  azimuth 
errors  and  4.3xl0“6  radians  for  elevation  errors.  (4:3) 

Assuming  azimuth  and  elevation  errors  are  statistically 
independent  of  each  other,  the  data  covariance  matrix  can  be 
defined  as 

[Q]  =  T agJ  =  fl  •  225x10" 9  1 . 849x10”  1  'j  (3.1) 

Processed  Data 

The  dynamics  equations  are,  in  part,  f mictions  of 
longitude  and  latitude.  A  bit  of  foreknowledge  allows  the 
simplification  of  the  observation  matrix,  [H],  in  the  Kalman 
filter  algorithms  presented  in  later  chapters.  This 
simplification  of  [H]  was  achieved  by  converting  azimuth  and 
elevation  into  longitude  and  latitude.  The  data  covariance, 
[Q],  was  also  converted.  This  section  derives  longitude  and 
latitude  in  terms  of  elevation  and  azimuth  as  well  as  the 
Jacobian  for  converting  [Q], 

From  Figure  3.2  and  the  planar  law  of  sines 

r/sin  y  =  R^/sin  El  (3-2) 

(5:3-4) 

where  r  is  the  distance  from  the  sensor  to  the  earth’s 
center  and  R  is  the  radius  of  the  earth. 

Solving  for  y 

y  =  sin'1f(r-sin  El)/R  1  (3.3) 
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From  the  geometry,  90°  <  y  <  180°,  since  a  y  <  90°  would 
indicate  a  TAV  located  behind  the  earth,  and  that  would  make 
it  unobservable.  Solving  for  a  (from  Figure  3.2.) 

a  =  180°  -  (El  +  y)  (3.4) 

The  spherical  geometry  of  this  problem  is  represented 
in  Figure  3.3. 


North  Pole 


Sensor 


Figure  3.3.  Spherical  Geometry  of  TAV  Tracking  Problem 

(6:3-5) 

The  law  of  sines  for  oblique  spherical  triangles  gives 
(sin  6)/fsin(90°  -  Azl  =  (sin  a)/sin  90°  (3.5) 
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Solving  for  6 


cos  Az 


6  =  sin' '  ^sin  a  -cos  Azj 

Combining  Equations  (3.3)  and  (3.4)  with  Equation  (3.6) 


(3.6) 


6  =  sin'  ^sin^lSO0-  ^E1 


+  sin*1(rsin  El  /  R 


•>)] 


cos  Azj 
(3.7a) 


6  =  sin_1£sin^El  +  sin_1(rsin  El  /  R^)j  cos  Az^J  (3.7b) 
Also  from  Figure  3.3 


where 


X  =  X  +  AX 

istiior 


X  =  sensor  longitude 

•  e  n  e  o  r 


(3.8) 


AX  =  TAV  longitude  relative  to  sensor's 
From  spherical  geometry 

sin  AX  =  tan  6  -cot (90°  -  Az )  (3.9a) 

or 

AX  =  sin_1|tan  6  -cot  (90°  -  Az)j  (3.9b) 

Substituting  Equations  (3.7b)  and  (3.9b)  into  Equation  (3.8) 

X  =  X  +  sin" tan| sin'  | sin(El  +  sin” ’[r -sin  El  /R  ]) 

sensor  ^  L  l  • 


cos  Az  • tan  Az 


(3.10) 


Equations  (3.7b)  and  (3.10)  define  the  relation  between  El, 
Az  and  X,  6.  From  the  geometry,  6  and  AX  are  constrained  to 
be  between  -90*  and  90°,  so  there  is  no  uncertainty  as  to 
the  quadrant  within  which  either  angle  resides.  Therefore, 

6  and  X  are  completely  defined. 

The  transformation  from  [Q  ]  to  [Q.  t)  is  simply 

A  z  ,  E  1  X  ,  o 

[Q]  =  CQ.  =  [J][Qa  fi3U]T  (3.11) 

A  ,  O  A  2  ,  E  1 
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where 


[J]  is  the  system  Jacobian 
Since  Equations  (3.7b)  and  (3.10)  are  of  the  form 

X  =  ft(Az,El) 


5  =  f  (At, El) 
2 


(3.12a) 

(3.12b) 


then 


[J]  = 


where  (6:3-7  through  3-9) 


at  at 

1  l 

dAz  dEl 

af  af 

2  2 

aXi  all 


(3.13) 


-1  =  ^1-  £tan  ^sin' '^El  +  sin' 1 


•sin  El  cos  Az 


tan  Az 


}- i / 2  r  , 

•  sec2  ^sin*  'jsin £e1  +  sin' 1  ^-jp-sin  Eljj 


cos  Az 


^  1  -  ^sin^El  +  sin'  1  j^-sin  Eljjcos  Az|  j 
•(-sin  Az)-(tan  Az)-^sin|^El  +  sin' 1  ^-  sin  Eljj| 


•  (sec2Az)  tankin' ^sinJ^El  +  sin' *  ^--sin  Eljjcos  Az 


j.  =  ^  1  -  £tan ^sin"  1^sin j^El  +  sin" 1  ^-  sin  Eljjcos  Az^j 

tan  Az  j  |  •  |sec2  ^sin'  ’^sin^El  +  sin' 1  ^-^-sin  Eljj 

cs  Az|j  ■  ^  1  -  jsin^El  +  sin' 1  ^-^-  sin  Eljj -cos  Az|  j 


ccs  Az 


3-6 


■  cos  Az  -cos^El  +  sin* 1  sin  Eljj 
•  |  1  +  £  1  -  ^-j^-sin  El  j  J  — j£—  •  cos  El|tan  Az 


aAf  =  (  1  '  {sin[E1  +  sin'^-^  sin  Eljj  cos  AzJ  j 


•sin  El  +  sin 


^-^-■sin  Eljj-^-sin  AzJ 


=  ^  1  -  ^sin^El  +  sin'1^-^— 


sin  El  • cos  Az 


)T” 


■cos  Az  -cos 


^El  +  sin* 1  ^-^-  sin  EljJ 


{ 1  *  [ 1  -  (-fsin  E1)l  '  2— ^ cos  E1} 


Equations  (3.7b),  (3.10),  and  (3.13)  define  the 
necessary  numerical  tools  for  converting  data  and  data 
covariance  from  Az,  El  to  X,  8.  Their  usage  is  presented  in 
the  Kalman  filter  derivations  in  Chapters  IV  and  V. 
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IV.  Six  State  Kalman  Fi 1  ter 


The  Kalman  filter  developed  by  Ziegler  has  been  revised 
after  a  careful  analysis  of  its  performance  when  subjected 
to  measurements  with  zero-mean,  Gaussian  random  variable 
components.  This  chapter  explains  the  motivation  for  a  six 
state  Kalman  filter,  explains  design  and  tuning,  and 
documents  the  filter's  performance. 

Motivation 

The  result  of  tracking  a  TAV  should  be  useful 
information  about  the  current  state  of  the  vehicle  and 
apparent  intentions  in  the  next  few  moments.  A  reasonable 
amount  of  data  would  be  the  TAV’s  position,  its  velocity  and 
heading,  and  any  observable,  applied  accelerations.  The  six 
states  of  this  Kalman  filter  contain  all  of  the  above 
information  in  longitude,  latitude,  velocity,  heading, 
intrack  acceleration,  and  transverse  acceleration.  This 
filter  will  estimate  all  of  these  states  for  every  data 
point . 

State  Equation 

Equation  (2.20),  in  a  linear  approximation,  defines  the 
TAV  dynamics. 
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(4.1) 


This  equation  is  the  filter's  model  of  TAV  flight  dynamics 
for  all  possible  accelerations. 

State  Transition  Matrix 

Discrete  time  propagation  of  the  state  vector,  x,  in 
Equation  (4.1)  is  of  the  form 

*i+1(t)  =  f[x.(t),At]  (4.2) 

The  state  transition  matrix  is  found  by  taking  the  gradient 

C<*,(ti4i'ti)]  =  Vx  («Cx4  (  *  )  ,  t  (4.3) 

which,  expanded,  is 
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•  At  +  1 


ah  V  -cos  h  -sin  6 

ui  _  _i _ i _ j_ 

dh  R  *  cos  8. 


i  4  1  _ 


sin  ht  •  sin  6^ 


R  -cos  8 


dh  -  At 

i  4l  _ 


—  =  At 


ax  as  av  aa 

i  4  1  _  i  4  1  _  i4l  _  I  1  4  1 


and  all  other  partials  are  equal  to  zero. 


Measurements  (3:44) 

Data  is  assumed  to  consist  of  a  deterministic  portion 


and  a  zero-mean,  white  Gaussian  noise,  v  . 


where 


z  =  h[x(tj),ti]  +  vt 


rr-,4  >  t  _  fl  0  0  0  0  0] 

h[x(  1 4  )  ,  1 4  ]  -  |q  1  0  Q  0  0J 


(4.5) 


and  v  has  strength 


[Q]  =  [J][Q„  „][J]T 


with  [J]  and  [Q  ]  defined  in  Equations  (3.13)  and  (3.1) 

a  z  ,  •  1 


[H]  is  defined  as 


aKC  x  t  ( 1 1 ) ,  1 4 0  0  0  0  0-| 

=  -Z  1°  1  0  0  0  oj 


(4.6) 
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State  Covariance  (3:44) 


To  allow  easy  starting  of  the  filter,  each  state  at 
t  =  0  was  assumed  independent  of  the  other  states,  and 
covariance  could  be  assumed  to  be  of  the  form 

■  K  °l  <  <  <,  <ri  <"-7> 

This  allows  the  entry  of  six  values  as  opposed  to  a  fully 
populated  6x6  matrix. 

Covariance  is  propagated  via 


[P  ]  =  [♦  ][P  ][•  ]T  +  [Q  ] 

L  1*1J  i  *  * ,  l  n 


(4.8) 


where  [4>  ]  is  defined  by  Equation  (4.4)  and  [Q  ]  is  the 

i  ♦  1 ,  i  n 

dynamics  noise  matrix,  which  is  the  strength  of  the  zero 
mean  Gaussian  white  noise  representing  the  uncertainty  in 
the  dynamics  model .  [Q  ]  is  assumed  to  be  diagonal . 

n 

[Q  ]  =  [Q  Qn  Q_  Qn  Qn  Qn  J  (4-9) 

n  n  _  n  f  n  n  n  n 

X  O  h  V  »1  «T 

The  six  diagonal  elements  of  [Q  )  will  be  adjusted  through 

n 

the  tuning  process. 


Filter  Algorithm  (5:100) 

The  extended  Kalman  filter  equations  are 

[K(t,)l  =  [P(t;)3[H]T|[H][P(t;)UH]T  ♦  [Q] 


■,,  =  { 


[I]  -  [K(ti  )][H]KP(t‘)] 


[P(t 

6x( t*)  =  5x( t “ )  +  [K(t  )]{  7  -  [H]6x( t 


where 


[K]  =  Kalman  gain  matrix 
[P(t[)3  =  state  covariance  prior  to  update 
[ P( t * ) ]  =  state  covariance  after  update 


(4.10) 

(4.11) 

(4.12) 
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[Q]  =  measurement  noise  strength 
[I]  =  6x6  identity  matrix 
6x(t‘)  =  prior  correction  to  state  estimate 
6x(t*)  =  new  correction  to  state  estimate 
r  =  data  residual 

Z 

Equation  (4.12)  is  iterated  until  the  correction  to  each 
state  is  less  than  .001%  of  the  current  estimate  of  that 
state . 

Tuning 

All  tuning  was  performed  through  Monte  Carlo  analyses. 
Monte  Carlo  analysis  consisted  of  a  series  of  fifteen 
trajectory  simulations  differing  only  in  the  random  noise  on 
each  measurement.  The  filter  estimated  the  states  through 
all  of  these  simulations,  and  the  mean  and  covariance  of 
each  state's  error  were  calculated.  The  dynamics  noise 
strength  was  adjusted  until  the  square  root  of  the  diagonal 
components  of  the  filter  covariance  matrix  were  slightly 
more  than  the  error  magnitude.  For  example,  raising  the 
strength  of  the  dynamics  noise  would  inform  the  filter  that 
it  should  trust  the  dynamics  less,  and  the  filter  covariance 
would  thus  increase  via  Equation  (4.8).  This  resulted  in  a 
filter  whose  own  estimate  of  it's  error  (the  filter 
covariance)  was  slightly  pessimistic:  it  overestimated  the 
size  of  it's  errors.  The  six  state  filter  was  tuned  for  one 
second  data  intervals  for  the  flight  profile  defined  in 
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Table  (IV.l),  starting  from  the  initial  conditions  in  Table 
(IV. 2). 


Table  IV.l.  Flight  Profile,  1  G  Accelerations 


Time  (sec) 

Time  (TU) 

Maneuver 

0-60 

0  -  .074 

Constant  Speed 

61  -  180 

.075  -  .223 

1  G  Intrack  Acceleration 

181  -  300 

.224  -  .372 

Constant  Speed 

301  -  420 

.373  -  .521 

1  G  Transverse  Accel . 

421  -  480 

.522  -  .595 

Constant  Speed 

I 

!  Table  IV. 2.  Central  Trajectory  Initial  Conditions 


State 

Covariance 

X  =  0.0  rads 

=  1.25e-5  rads2 

6  =  0.0  rads 

P^  =  1.25e-5  rads2 

h  =  0.7854  rads 

P  =  3.e-3  rads2 

hh 

V  =  0.5  DU/TO 

P  =  3 . e-2  (DU/TU2)2 
vv 

af  =  0.0  DU/TU2 

Pit  =  3 . 5e-2  (DU/TU2)2 

aT  =  0.0  DU/TU2 

Ptt  =  2.5  (DU/TU2)2 

The  dynamics  noise  matrix  values  that  presented  the 
best  performance  are  given  in  Table  (IV. 3).  The  square  root 
of  the  filter  covariance  and  the  average  state  error  (from 
fifteen  Monte  Carlo  runs)  for  both  heading  and  intrack 
acceleration  are  presented  in  Pigures  (4.1)  and  (4.2)  for 
the  one  second  data  interval  with  1  G  accelerations.  These 
plots  are  representative  of  the  filter's  performance  in 
tracking  all  six  states.  Note  the  axis  scale  factors  in  the 
corners  of  the  plot.  Also,  the  distinct  peaks  on  both  plots 
are  indicative  of  the  filter's  lag  in  detecting  the 
occurrence  of  accelerations. 


Table  IV. 3.  Dynamics  Noise  Strengths,  Six  State  Filter, 

One  Second  Interval 


Qxx 

= 

1 . e-14 

( rads ) 2 

Q66 

= 

2 . e-14 

( rads) 2 

Q 

- 

l.e-13 

( rads ) 2 

h  h 

Qy  V 

= 

6 .  e-11 

(DU/TU)2 

s 

8 .  e-3 

(DU/TU2) 

Qtt 

= 

4 . 5e-3 

(DU/TU2) 
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— .  :  Mt-ktvjOe  o*  averaje  e^'c x 
sch-c  *  root  cf  f*ter  co*#r.ance 


O.OOC  0.60C  I.20C  1.80C  2.40C  3.  DOC  3.60C  4.20G  4.80C  S.4X  6.00T 

TIN.-  (TUS- 

Figure  4.1.  Heading  Covariance  and  Error,  1  G,  1  Second 
Data  Interval,  Six  State  Filter 


-  ■H^.tuoe  c'  »v^e|e  e'f-or 
sof-c  -  root  o'  fiXf  COv#r^nce 


O.OOC  0.600  I.20C  1.800  2.400  3.00C  3.60C  4JG0  4.800  S.400  6.00C 


TI1F  (TL's> 


Figure  4.2.  a  Covariance  and  Error,  1  G,  1  Second 


Data  Interval,  Six  State  Filter 


The  gradual  rise  in  both  heading  covariance  and  heading 
error  appeared  to  indicate  an  unstable  filter  where  error 
increases  with  time.  A  trajectory  which  flew  backwards 
towards  the  initial  conditions  showed  reverse  trends  in 
filter  performance,  indicating  that  filter  performance  is  a 
function  of  the  distance  from  the  sensor's  projection  upon 
the  earth's  surface.  The  earth's  curvature  apparently 
degrades  the  filter's  performance. 

Intrack  acceleration  error  spiked  at  tno  * eginning  and 
end  of  the  1  G  maneuver.  The  narrowness  of  those  spikes 
indicate  that  the  filter  rapidly  recognized  the  presence  of 
the  maneuver. 

The  variation  of  state  errors  among  the  fifteen  Monte 
Carlo  runs  also  indicate  filter  performance.  Figures  (4.3) 
and  (4.4)  show  that  average  heading  and  intrack  acceleration 
errors  remained  close  to  a  mean  of  zero  except  when 
maneuvers  started  or  ended.  The  -  1  a  curves  represent  the 
amount  that  errors  varied  among  the  Monte  Carlo  runs.  The 
relative  tightness  of  the  -  1  a  curves  indicate  that  the  six 
state  Kalman  filter  consistently  estimated  TAV  states 
throughout  all  the  Monte  Carlo  runs. 
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-  «1  9*»B 

» o*3  =  avr-«*e 
-  -  -  -l  n»e 


C  00C  0.6OC  1.20C  l.flCC  2.4QC  3.00C  3.6 OC  4  200  4  000  S.OC  «.0 

TIME  (T-l-s) 

Figure  4.3.  Monte  Carlo  Heading  Error  Statistics 
1  Second  Interval,  Six  State  Filter 


.  •  »  \ 

so t>c  =  average  \ 

...  -I  ;,|ta  \\ 


A  * .  A  *  {  A..' 

a  -  -  ^  \v  - 


i 


0.000  0.6OC  1.200  1.800  2.400  3.000  3.600  4.200  4.800  5.400  6 

TIME  (TUs) 


Figure  4.4.  Monte  Carlo  Error  Statistics, 
1  Second  Interval,  Six  State  Filter 


The  other  four  states  exhibited  performance  similar  to 
the  two  states  above.  These  plots  are  presented  in 
Appendix  A. 

The  ten  second  data  interval  also  estimated  the  TAV's 
state  over  the  trajectory  defined  in  Table  (IV. 1)  from  the 
initial  conditions  listed  in  Table  (IV. 2).  The  dynamics 
noise  matrix  for  this  filter  is  listed  in  Table  (IV. 4). 
Heading  and  intrack  acceleration  covariance  plots  are  given 
in  Figures  (4.5)  and  (4.6). 

Table  IV. 4.  Dynamics  Noise  Strengths,  Six  State  Filter, 

10  Second  Data  Interval 


= 

3 . e-10 

(rads)2 

°55 

= 

5 . e-10 

( rads ) 2 

Q 

= 

l.e-12 

( rads ) 2 

hh 

Qvv 

= 

l.e-9 

(DU/TU)2 

Q„ 

= 

6 .  e-2 

(DU/TU2)2 

Qtt 

= 

6 .  e-  2 

(DU/TU2)2 

TT 
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Monte  Carlo  error  statistics  for  the  ten  second  data 
interval  filter  were  slightly  degraded  compared  to  the  one 
second  data  interval  filter.  Heading  and  intrack 
acceleration  error  statistics  are  presented  in  Pigures  (4.7) 
and  (4.8).  The  other  states'  covariance  plots  are  presented 
in  Appendix  A.  All  remaining  error  t  a  plots  are  presented 
in  Appendix  C. 


TIME  (TL's) 


Figure  4.7.  Monte  Carlo  Heading  Error  Statistics,  1  G, 
10  Second  Interval,  Six  State  Filter 
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§.ir 

-  ; - 1 - 1 - 1 - i - 1 - 1 - 1 - 1 - r 


2 - 1 - 1 - 1 - 1 - 1 - ' - 1 - i - 1 - 1  .itr' 

O.OOC  0.600  1J0C  1.60C  2.40C  3.000  3600  4J0C  4J00  5.400  6.000 

TIME  <TUS> 

Figure  4.8.  Monte  Carlo  Error  statistics,  1  G, 

10  Second  Interval,  Six  State  Filter 

Filter  Performance 

In  order  to  evaluate  the  filter’s  ability  to  properly 
estimate  states  for  a  TAV  located  anywhere  within  view  of 
the  sensor,  two  additional  sets  of  initial  conditions  were 
used  with  the  flight  profile  given  in  Table  (IV. 1)  and  the 
dynamics  noise  matrix  given  in  Table  (IV. 3).  The  first  set 
was  a  northward  trajectory  starting  from  a  point  closer  to 
the  north  pole. 


4-15 


Table  IV. 5.  North  Trajectory  Initial  Conditions 


State 

Covariance 

X  =  0.0  rads 

P  =  1.25e-o  rads2 

6  =  1.0472  rads 

=  1.25e-5  rads2 

h  =  0.0  rads 

P  =  3.e-3  rads2 

hh 

V  =  0.5  DU/TU 

Pyv  =  3 . e-2  (DU/TU2)2 

a5  =  0.0  DU/TU2 

Pjt  =  3 . 5e-2  (DU/TU2)2 

a  =0.0  DU/TU2 

P  =2.5  (DU/TU2)2 

T 

TT 

Figure  4.9.  North  Trajectory  Longitude  Covariance  and 
Error,  1  G,  1  Second  Interval,  Six  State  Filter 
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Longitude  becomes  less  certain  near  the  north  pole  due 
to  the  longitude  singularity  at  the  pole,  and  Pigure  (4.9) 
is  clearly  consistent  with  this  fact.  As  before,  the  other 


states'  covariance  plots  are  presented  in  Appendix  A. 

Another  trajectory  used  the  flight  profile  in  Table 
(IV. 1)  with  the  initial  conditions  given  in  Table  (IV. 6). 
This  east  trajectory  gave  additional  support  that  the  six 
state  filter  remained  viable  near  the  eastward  (and 
westward)  limits  of  sensor  view.  All  covariance  plots  for 
this  trajectory  are  presented  in  Appendix  A. 

Table  IV. 6.  East  Trajectory  Initial  Conditions 


: 

State 

Covariance 

X  =  1.0472  rads 

Pu  =  1 . 25e-5  rads2 

6  =  0.1745  rads 

=  1.25e-5  rads2 

h  =  1.5708  rads 

P  =  3.e-3  rads2 

hh 

V  =  0.5  DU/TU 

Pyv  =  3 . e-2  (DU/TU2)2 

af  =  0.0  DU/TU2 

Pn  =  3 . 5e-2  (DU/TU2)2 

aT  =  0.0  DU/TU2 

Ptt  =  2.5  (DU/TU2)2 

A  9  G  acceleration  profile,  Table  (IV. 7),  was  also 
investigated  using  the  central  trajectory  initial  conditions 
of  Table  (IV. 1)  and  the  appropriate  dynamics  noise  matrices 
for  the  one  and  ten  second  interval  filters.  Although  these 
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two  filters  had  degraded  performance,  they  still  made 
adequate  estimates  of  TAV  states.  Intrack  acceleration 
curves.  Figures  (4.10)  and  (4.11),  demonstrate  adequate 
state  estimation  by  both  the  one  and  ten  second  interval 
filters.  The  curves  for  the  remaining  five  states  are 
presented  in  Appendix  B. 


Table  IV. 7.  Flight  Profile,  9  G  Accelerations 


Time  (sec) 

Time  (TU) 

Maneuver 

0-60 

0  -  .074 

Constant  Speed 

61  -  180 

.075  -  .223 

9  G  Intrack  Acceleration 

181  -  300 

.224  -  .372 

Constant  Speed 

301  -  420 

.373  -  .521 

9  G  Transverse  Accel . 

421  -  480 

.522  -  .595 

Constant  Speed 

•Ill /nil)  HW‘i]'  .!  ilj  M  IH^INI 


TIME  (TUS) 


Figure  4.10.  Covariance  and  Error,  9  G,  1 


Interval,  Six  State  Filter 
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0.000  0.60C  1.20C  1.800  2.400  3.000  1600  4.200  4.800  5.400 
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Figure  4.11.  a  Covariance  and  Error,  9  G,  10 


Interval,  Six  State  Filter 


Second 


-  *10_1 
6.00C 


Second 


The  six  state  filter,  executed  at  both  one  and  ten 
second  data  intervals,  was  found  to  adequately  estimate  all 
TAV  states  through  1  G  and  9  G  maneuvers.  The  remainder  of 
this  study  sought  a  filtering  algorithm  which  could  exceed 
the  six  state  filter's  performance. 
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V.  Four  State  Kal.aan  Filter 


The  second  filter  developed  for  this  tracking  problem 
was  a  reduced  order,  four  state  Kalman  filter.  This  chapter 
relates  the  motivation  for  a  four  state  filter,  the  design 
and  tuning  process,  and  the  filter's  performance. 

Motivation 

The  six  state  filter  tracks  the  transatmospheric 
vehicle  through  periods  with  acceleration  and  periods 
without  acceleration.  Most  current  aircraft  fly  long 
periods  of  "cruise"  at  an  essentially  constant  speed.  The 
transatmospheric  vehicle  would  also  cruise  in  this  manner 
when  flying  point-to-point  missions,  to  alien  its  ascent  to 
orbit  with  a  rendezvous  target,  and  to  return  to  its  base 
after  missions.  During  these  quiescent  (without  intrack  or 
transverse  acceleration)  periods,  the  two  acceleration 
states  are  carried  along  in  the  six  state  filter  for  no 
useful  purpose.  The  four  state  filter  is  designed  to  track 
the  target  during  these  less  computationally  taxing  periods, 
taking  advantage  of  the  reduced  number  of  states  by  assuming 
zero  acceleration,  thus  eliminating  calculations  containing 
any  acceleration  terms. 
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State  Equation 

With  the  elimination  of  the  acceleration  states,  the 

dynamics  of  the  transatmospheric  vehicle.  Equation  (2.20), 

reduce  to  the  linear  approximation 

X  1  r ( V  sin  h  /R  -cos  6  )  -  u  1  [x 

i  ♦  1  i  i  s  i  s  i 

6  (V  -cos  h  )/  R  6 

wi  i  i  •  i 

h  -a  /V  +  [  V  -sin  h  -sin6  /(R  cos6  )]  +  h 

i *  1  Ti  1  i  i  i  •  i  i 

V  a  V 

Will  i 

Assuming  that  acceleration  will  be  zero  during  the  use  of 
this  filter  further  reduces  the  state  equation  to 


(V  -sin  h  /  (R  -cos  6  ) )  -  <*> 

i  is  i  s 

(V  -cos  h  )/  R 

i  1  e 

(V  -sin  h  -sin  6  )/  (R  -cos  6  ) 
1  i  i  s  i 


(5.2) 


This  equation  is  a  model  of  the  transatmospheric  vehicle  in 
a  quiescent  period.  No  attempt  is  made  to  accommodate 
accelerations  because,  in  the  presence  of  accelerations,  the 
total,  adaptive  filter  will  execute  the  six  state  filter  to 
properly  estimate  the  acceleration  states. 


State  Transition  Matrix 

Discrete  time  propagation  of  the  state  vector,  x,  in 
Equation  (5.2)  is  of  the  form 


x  (t)  =  f[x  (t),At] 

i*i  i 


(5.3) 
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The  state  transition  matrix  is  found  by  taking  the  gradient 


which,  expanded,  is 


(  [f[x  (t),  t]j 


(5.4) 
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where 


^14! 

~"c53 
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Measurements  (3:44) 

Data  is  assumed  to  consist  of  a  deterministic  portion 
and  a  zero-mean,  white  Gaussian  noise,  v  . 

i 

z  =  h[x(t . ) ,  t  ]  +  v  (5.6) 

»  i  i 

where 

=  [  J  J  o  o]'5 

and  v(  has  strength 

[Q]  •  UHQ  ,][)]' 

with  [J]  and  [Q  ]  defined  in  Equations  (3.13)  and  (3.1). 

•  z  ,  •  1 

[H]  is  defined  as 


[H] 


aH[x(ti),tj] 

6x 


1  0  0  0] 

0  1  0  0J 


(5.7) 


State  Covariance  (3:44) 

For  convenience  in  starting  the  filter,  each  state 
variable  at  t  =  0  is  assumed  independent  of  the  other 
states,  or 

[p0]  =  °6  °h  aV-l  (5.8) 

This  allows  the  entry  of  four  values  as  opposed  to  a  fully 

populated  4x4  matrix. 
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(5.9) 


Covariance  is  propagated  via 


*  I*,.,.,!!*.!!*,.,.,!’  +  10.] 


where  [♦  ]  is  defined  by  Equation  (5.5)  and  [Q  ]  is  the 


dynamics  noise  matrix,  which  is  assumed  to  be  diagonal. 


[Q  ]  =  TQ  Q  Q  Q  J 

n  nX  n6  nh  nV 


(5.10) 


The  four  diagonal  elements  of  [Q^]  will  be  adjusted  through 
the  tuning  process. 


‘‘liter 


(5:100) 


The  extended  Kalman  filter  equations  are 

[K(t4)]  =  [P(t‘)][H]T|[H][P(t‘))[H]T  +  [Q]|^  1 

*)]  =  |tl]  ~  [K(t. ))[H]J[P(t;)] 

tj)  =  6x(t;)  +  [K(ti)]|?2  -  [H]5x(t;)J 


(P(t 


6x(tp  =  6x(t;)  +  [K(t 


(5.11) 


(5.12) 


(5.13) 


which  is  the  same  as  presented  in  Chapter  IV. 


Tunin< 


Just  as  in  the  case  of  the  six  state  filter,  the 
dynamics  noise  matrix,  [Qn]>  was  adjusted  until  the  square 
root  of  the  diagonal  components  of  the  filter’s  covariance 
matrix  (after  the  measurement  update)  were  just  slightly 
higher  than  the  average  error  found  via  Monte  Carlo 
analysis.  The  four  state  filter  was  tuned  for  a  flight 
profile  without  any  applied  accelerations.  The  initial 
conditions  are  the  same  as  the  central  trajectory  initial 
conditions  from  Chapter  IV  and  are  repeated  in  Table  (V.l). 
The  dynamics  noise  matrix  values  used  for  this  study  are 
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listed  in  Table  (V.2)  for  the  one  second  interval  and  in 
Table  (V.3)  for  the  ten  second  interval. 


Table  V.l.  Central  Trajectory  Initial  Conditions, 

Four  State  Filter 


State 

Covariance 

X  =  0.0  rads 

Pxx  =  1 . 25e-5  rads2 

5  =  0.0  rads 

Pcc  =  1.25e-5  rads2 

66 

h  =  0.7854  rads 

P  =  3.e-3  rads2 

hh 

V  =  0.5  DU/TU 

P  =  3 . e-3  (DU/TU)2 
vv 

aj  =  0.0  DU/TU2 

a  =0.0  DU/TU2 

T 

Table  V.2.  Dynamics  Noise  Strengths,  Four  State  Filter 

One  Second  Data  Interval 


=  0.0  rads' 


=  0.0  rads 
=  l.e-26  rads2 
=  l.e-26  (DU/TU)' 
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Table  V.3.  Dynamics  Noise  Strengths,  Four  State  Filter, 

Ten  Second  Data  Interval 


Qu  -  0.0  rads2 
=  0.0  rads2 
{5  =  l.e-16  rads2 

h  n 

Qvv  =  l.e-16  (DU/TU)2 


The  four  state  filter’s  performance  was  demonstrated  by 
the  longitude  covariance  plots.  Figures  (5.1)  and  (5.2),  for 
the  one  and  ten  second  interval  four  state  filters. 

Although  the  one  second  interval  plot  shows  the  error 
exceeding  the  square  root  of  covariance  halfway  through  the 
plot,  this  version  of  the  four  state  filter  gave  the  best 
performance  when  integrated  into  the  adaptive  filters. 
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VI .  Multiple  Model  Adaptive  Kalman  Fi Iters 


When  a  system  model  itself  may  be  subject  to  change, 
multiple  model  adaptive  filtering  can  be  used  to  compare  the 
performance  of  several  filters,  each  based  upon  a  different 
system  model.  Sub-filter  estimates  could  be  used  either 
individually  or  in  weighted  averages  of  those  estimates. 

This  section  presents  three  different  approaches  for  the 
application  of  adaptive  filtering  to  this  estimation 
problem.  All  of  the  adaptive  filters  presented  estimated 
the  states  for  the  1  G  flight  profile  starting  from  the 
central  trajectory  initial  conditions. 

Acceleration  Switched  Adaptive  Filter 

The  four  state  filter  developed  in  chapter  V  was  meant 
to  model  TAV  dynamics  in  the  absence  of  applied 
accelerations.  The  six  state  filter  modeled  the  presence  of 
accelerations.  Rather  than  running  both  the  six  state  and 
four  state  filters  simultaneously,  the  first  attempt  at 
adaptation  was  to  switch  from  the  six  state  to  the  four 
state  and  back  again  based  upon  the  six  state  estimate  of 
acceleration  and  the  four  state  filter's  residuals. 

Residuals  were  measured  before  the  measurement  updates  for 
each  data  interval .  This  was  intended  to  decrease  estimate 
errors  and  minimize  computer  time  required  for  the  adaptive 
filter. 
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The  algorithm  for  the  acceleration  switched  adaptive 
filter  begins  with  the  six  state  Kalman  filter  Equations 
(4.10),  (4.11)  and  (4.12),  repeated  here  with  the  subscript 


6’  to  indicate  the  six  state  filter. 


t|[h 


(6.1) 


(6.2) 


(6.3) 


[Vl  !]  =  ♦  to.]}"  (6-1) 

[P6(t;>]  =  |[I6]  -  [K6(t1)HH6]|[P6(t;)]  (6.2) 

s;6(tP  *  6le(t;>  *  -  tH61SS(ti>}  (6-3) 

Normal  six  state  filter  operations  continued  until  both 
a  and  a  estimates  dropped  below  0.02  G's.  At  that  point 

T  T 

the  accelerations  were  assumed  to  be  zero  and  the  four  state 
filter  was  initiated  using  the  first  four  components  of  the 
six-state  state  vector  along  with  the  corresponding  4x4 
section  of  the  covariance  matrix.  The  remaining  covariance 
values  were  stored  to  allow  the  six  state  filter  to  restart 
in  the  future.  The  four  state  filter  equations  (5.11), 
(5.12),  and  (5.13)  are  repeated  below. 

[K4(t  )]  =  [P/t;>]  [H4]T|[H4][P4(t;)][HjT  +  [Q4]j  1  (6.4) 
[p4(t;n  =  j[i4]  -  [K4(ti)][H4]|[P4(t:)]  (6.5) 

6x 4 ( t  *  )  =  6x 4 ( t  j )  +  [K4(ti)]|Fi  ^  -  [H4)6l4(t^)|  (6.6) 

The  four  state  filter  continued  to  operate  until  either 
the  average  of  the  last  two  longitude  residuals  or  the 
average  of  the  last  two  latitude  residuals  exceeded  7  x  10'6 
radians.  At  this  point,  the  four  state  filter  was  assumed 
to  be  diverging,  and  the  four-state  state  vector  augmented 


(6.5) 


(6.6) 
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with  two  teroes  was  fed  into  the  six-state  state  vector. 

The  four  state  covariance  matrix,  augmented  with  the  unused 
values  discussed  above,  was  inserted  into  the  six  state 
covariance,  and  the  adaptive  filter  switched  back  to  six 
state  filter  operations  until  accelerations  once  again 
dropped  below  the  lower  bound.  The  two  switching  bounds, 
0.02  G's  for  acceleration  and  7  x  10‘6  radians  for  position, 
were  found  to  give  the  best  state  estimates  for  this 
algorithm. 

Unfortunately,  this  ad  hoc  approach  to  adaptive 
filtering  did  not  markedly  decrease  filter  errors,  nor  was 
it  an  improvement  during  quiescent  periods.  Figure  (6.1) 
depicts  slight  increases  in  heading  covariance  during  the 
four  state  filter’s  activity.  The  rest  of  the  curve  is 
essentially  the  same  as  the  curve  for  the  six  state  filter. 
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TIME  (Tils) 

Figure  6.1  Heading  Covariance  and  Error,  1  G,  1  Second 
Interval,  Acceleration  Switched  Adaptation 

Residual  Switched  Adaptive  Fi 1  ter 

This  second  attempt  at  adaptation  abandoned  the  idea  of 
running  only  one  filter  at  a  time.  For  this  adaptation  the 
longitude  and  latitude  residuals  were  monitored  in  order  to 
choose  which  filter  (model)  best  represented  the  TAV’s 
dynamics  during  the  current  data  interval . 

The  root-mean-squares  of  the  longitude  and  latitude 
residuals  for  both  the  six  state  and  four  state  filters  were 
calculated.  Residuals  were  measured  before  the  measurement 
updates . 

RMS  =  /  0 . 5 ■ ( rf  +  r?  )  (6.7) 

4  T  '  X4  84 
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(6.8) 


*  -/o-5-(riV  rL>' 

The  smaller  of  the  two  RMS’s  would  indicate  the 
sub-filter  whose  estimate  was  chosen  for  that  time  interval. 
If  the  four  state  filter  was  chosen,  the  current 
acceleration  estimates  would  be  set  to  zero. 

This  attempt  at  adaptation  suffered  from  the  same 
problem  as  the  previous  attempt:  the  four  state  model  did 
not  adequately  improve  the  estimate  even  during  quiescent 
periods.  Figure  6.2  demonstrates  behavior  much  worse  than 
the  six  state  filter's  performance.  This  adaptive  filter 
exhibited  large  errors  and  was  abandoned. 


o.ooo  asoo  ijoo  ixc  hoc  xocc  ieoc  4joc  <joo  s.400  tooc 


TIME  (TUs) 

Figure  6.2  Heading  Covariance  and  Error,  1  G,  1  Second 
Interval,  Residual  Switched  Adaptation 


6-5 


robability  Weighting  Adaptive  Filter 


Both  the  six  state  and  four  state  sub-filters  generate 
state  estimates  for  each  data  point.  Probability  weighting 
used  the  sub-filters'  residuals  to  generate  the  probability 
that  either  sub-filter  model  was  the  correct  model  for  the 
system  at  any  given  time.  The  probability  density,  f^, 
associated  with  the  sub-filters  is  given  by 

VV  =  2n!  Ta'i  1 1/2  '  C-‘r’  (6’9) 

2nj[Ak]|  t  J  (3:132) 

where 


tV 


‘V 


+  [Qk] 

[h][p „(t:)][H]T  +  [o] 

k  i 


P  0 

k  ,  1  1 

0  P 


P  +  Q 

k  ,  1 1  it 


+  [Q] 


P  +  Q 

k , 22  22 


(6.10) 


Equation  (6.9)  is  of  the  form 


f  (t  )  =  0  •  exp 

k  i 


{-7  rl  [V’  r.} 


(6.11) 


The  0  term  is  commonly  set  to  one  in  order  to  enhance  the 
sensitivity  of  the  adaptive  filter  to  the  inadequacies  of 
the  sub-filters.  (l:a)  With  0  set  to  one  the  adaptive 
filter  switches  more  quickly  to  the  more  correct  sub-filter. 


and  the  probability  density  becomes 


f  (t  )  =  exp 

k  i 


{-i tv” 


(6.12) 
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The  probability  that  the  k-state  sub-filter  is  the  best 
model  is  given  by 


P  (t  )  =  f  (t  )P  (t  )/ 

k  i  k  i  k  i  -  1  ' 

{f  (t  )-F  (t  )  +  f  (t  )P  (t  )}  (6.13) 

v  4  i  4  i-1  6  i  6  i-1 

Adaptive  filter  state  estimates  are  given  by 

ft(t+)  =  p  (t  )  •  ft  (t+)  +  p  (t  )  •  ft  (t*)  (6.13) 

'  i  4  i  4  i'  i  6'  i'  v 

(3:131) 


and  covariance  by 

[p(t;n  =  p4(tt)  •  |[P4(tp]  +  [ft4(tp  -  ft(t*)] 

.  [ft  rt*)  -  ft(t*)]T)  +  p  (t.)  •  ([p  (t*)] 

+  [ft  ft*)  -  ft(t*)]  •  [ftft*)  -  ft(t*)]\  (6.14) 

6  i  *  6  i  i  I 

(3:131) 

For  this  application,  the  sub-filters  should  be  tuned 
optimistically  as  opposed  to  the  pessimistic  tunings 
performed  in  chapter  IV.  By  allowing  sub-filter  covariance 
to  be  close  to,  or  slightly  less  than,  the  actual  error,  the 
residuals  should  more  clearly  indicate  the  relative 
"goodness"  of  the  sub-filter  models.  Best  adaptive  filter 
estimates,  however,  occurred  when  the  six  state  filter 
utilized  the  dynamics  noise  matrices  presented  in  Tables 
(IV, 3)  and  (IV. 4),  and  when  the  four  state  filter  retained 
the  dynamics  noise  matrices  presented  in  Tables  (V.2)  and 
(V.3).  These  four  matrices  are  summarized  in  Tables  (VI. 1) 
and  (VI. 2). 
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Table  VI. 1.  Adaptive  Filter  Dynamics  Noise  Matrices, 

1  Second  Data  Interval 


Four  State  Filter 

Six  State  Filter 

Qxx 

0.0  rads2 

l.e-14  rads2 

Q56 

0.0  rads2 

2.e-14  rads2 

Q 

l.e-26  rads2 

l.e-13  rads2 

hh 

o 

< 

< 

l.e-26  (DU/TU)2 

6 . e-11  (DU/TU)2 

N/A 

8 . e-3  (DU/TU2)2 

Q 

N/A 

4 . 5e-3  (DU/TU2)2 

TT 

Table  VI. 2.  Adaptive  Filter  Dynamics  Noise  Matrices, 

10  Second  Data  Interval 


Four  State  Filter 

Six  State  Filter 

Qxx 

0.0  rads2 

3.e-10  rads2 

Q66 

0.0  rads2 

5.e-10  rads2 

Q 

l.e-26  rads2 

l.e-12  rads2 

hh 

Qvv 

l.e-26  (DU/TU)2 

l.e-9  (DU/TU)2 

Qn 

N/A 

6 . e-2  (DU/TU2)2 

Q„ 

N/A 

6 . e-2  (DU/TU2)2 

TT 

6-8 


The  heading  and  intrack  acceleration  covariance  plots 
for  the  one  and  ten  second  interval  adaptive  filters. 
Figures  (6.3)  through  (6.6),  demonstrated  a  slight 
improvement  in  intrack  acceleration  for  a  short  period  with 
some  degradation  in  heading.  The  other  states  were  also 
slightly  improved  or  degraded,  but  there  was  little  overall 
improvement  as  compared  to  the  six  state  Kalman  filter  of 
Chapter  IV.  For  the  sake  of  completeness,  this  adaptive 
filter  was  carried  forward  into  Chapter  VII’s  comparisons. 
The  other  two  adaptive  filters  were  not. 


0.000  0.600  IJOC  1.900  HOC  3.000  1600  <JO0  4.900  5.40G  6.000 

TIME  (TUs) 

Figure  6.3.  Heading  Covariance  and  Error,  1  Second 
Interval,  Probability  Weighting  Adaptation 
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TIME  (TUs) 

Figure  6.4.  aj  Covariance  and  Error,  1  Second  Interval, 
Probability  Weighting  Adaptation 


a 


C.OOC  0.600  UOQ  LKD  2.  *00  \3X  3-60C  4.200  4J0C  S.40C  6.00C 


TIME  (TUs) 

Figure  6.5.  Heading  Covariance  and  Error,  10  Second 
Interval,  Probability  Weighting  Adaptation 
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INTRACK  ACC.  SIGMA  (DU/Tlh2> 

a?20  0.440  0.660  0.881 


VII.  Smoother 


A  Kalman  filter  estimates  the  current  state  based  upon 
the  data  collected  prior  to  the  current  time.  After 
collecting  all  of  the  data,  another  filter  could  be  run 
backwards  in  time  from  the  end  of  the  data  to  estimate  the 
state  based  upon  all  of  the  data  collected  from  the  current 
time  until  the  end  of  the  data.  The  two  estimates  could  be 
optimally  combined  to  produce  an  estimate  of  the  state  based 
upon  all  of  the  data  collected.  This  process  is  called 
smoothing,  and  the  algorithm  is  known  as  a  smoother.  (2:2) 
This  chapter  explains  the  motivation  for  the  smoother  and 
its  derivation. 

Motivation 

All  of  the  previous  methods  were  potentially  real-time 
algorithms  that  would  take  TAV  position  data  and  immediately 
estimate  the  six  state  variables.  Adaptation  failed  to 
decrease  errors,  necessitating  another  approach  to  better 
estimate  acceleration  states.  A  smoother,  although  a  form 
of  Kalman  filter,  is  a  "post-flight"  analysis  tool  also 
known  to  improve  state  estimates,  including  the  acceleration 
states . 

Forward  Fi Iter 

The  forward  filter  is  the  same  as  the  six  state  filter 
developed  in  Chapter  V  where 
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(7.1) 


X  (t)  =  f[x  ( t )  ,  At ] 

F  ,  i  ♦  1  F  ,  i 


[* <t  )]  =  7  f  f[x  ( t  ) , At  ]  ) 

F  1  «F,  i  l  F'  ‘  J 

[KF(ttn  =  [PF(t;)][H]T|[H][PF(t;))[H]T  +  [Q]|  1 
[PF(tp]  =  |[I]  -  [KF(tt)][H]J[PF(t;>] 


6x  (t*)  =  6x  (t*)  +  [K 

F  i  F  i 


(7.2) 


(7.3) 


(7.4) 


(7.5) 


Backward  Fi Iter 

While  Equation  (7.1)  propagates  the  system  dynamics 
forward  in  time,  replacing  the  At  with  -At  will  propagate 


the  system  backward  in  time. 


x  (t)  =  f[x  (t)  ,-At] 

B  ,  1  -  1  L  B  ,  i 


Thus 


[P.U 


Sx  < t * )  =  Sx  (t‘)  t  [K  (t 

,  B  i  B  1  B 


(7.6) 


[Vt1.1'ti,]  =  Vx  f  fl*B  ]  <7'?> 

B  ,  i  t  J 

[K  (t  )]  =  [P  (t-)][H]TJ[H][P(t-)][H]T  +  [Q]l  1  (7.9) 

B  1  B  i  I  B  1  I 

pB(tP]  =  {[i]  ■  [KB(ti)][H]}[pB(t;)]  (7-io) 

)  =  6xe(t*)  ♦  [KB(ti)]|?B  z  -  [H]-6xB(t*)|  (7.11) 


(7.9) 


(7.10) 


(7.11) 


Smoothed  covariance  was  found  via  least  squares  where 


*  {'V  *  tp.)-’}'1 


(7.12) 


The  smoothed  state  vector  was  also  found  via  least  squares 


where 


x  =  [P  ] 

s  s 


(7.13) 
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This  algorithm  uses  the  "current”  data  point  in  both 
the  forward  and  the  backwards  filters.  This  causes  a  double 
weighting  of  that  data  point  in  the  smoother  estimates. 

One  and  ten  second  data  interval  smoothers  estimated 
the  states  for  the  1  G  flight  profile  from  the  central 
trajectory  initial  conditions.  Longitude  and  latitude 
estimates  suffered  large  errors  for  both  data  intervals  as 
demonstrated  in  Figures  (7.1)  and  (7.2).  Acceleration 
states  were  fairly  well  estimated  for  the  one  second  data 
interval  as  shown  in  the  intrack  acceleration  covariance 
plot.  Figure  (7.3).  The  ten  second  interval  smoother  showed 
some  bias  in  acceleration  estimates  during  accelerations,  as 
shown  in  Figure  (7.4).  The  other  states'  covariance  plots 
are  presented  in  Appendix  A. 


O.OOC  0.60C  L200  LflOO  2.400  1000  1600  4JOO  4.600  5.400  1000 


TIME  (TUS) 

Figure  7.1.  Longitude  Covariance  and  Error,  1  G,  1  Second 

Data  Interval,  Smoother 
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itlNGITUDE  SIGMfi  (RRDs) 


C.OOC  0.60C  I.JOC  l.flOC  2.<OG  3- DOC  XBOC  4JOO  4.500  5.400  tOOO 


TIME  (TUS) 

Figure  7.2.  Longitude  Covariance  and  Error,  1  G, 
10  Second  Data  Interval ,  Smoother 


COQC  0.6OC  IJOC  1J00  2.40C  3.00C  S.60C  4.200  4MC  5.400  6.00C 

TIME  ( T us) 

Figure  7.3.  a|  Covariance  and  Error,  1  G,  1  Second 
Data  Interval ,  Smoother 
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§  ,10° 


TIME  (TUs) 

Figure  7.4.  at  Covariance  and  Error,  10  Second 
Data  Interval ,  Smoother 


Theoretically,  smoother  estimates  should  be  no  worse 
than  the  forward  filter.  Investigation  indicated  that  the 
biases  in  the  acceleration  states  may  have  been  due  to 
forward  and  backward  filter  oscillations  in  response  to  step 
changes  in  acceleration.  All  of  the  states  suffered  from 
the  numerical  imprecision  inherent  in  the  standard  Kalman 
filter.  This  imprecision  may  have  been  worsened  by  the 
multiple  matrix  inversions  in  Equation  (7.12).  Longitude 
and  latitude  covariance  magnitudes  were  approximately  10~10 
radians2,  but  acceleration  covariances  were  as  large  as  10" 1 
(DU/TU2)2.  Such  a  matrix  is  poorly  suited  for  numerical 
inversion  routines  and  may  have  induced  estimate  errors. 
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VIII.  Filter  Comparisons 


In  order  to  compare  the  smoother,  probability  weighting 
adaptive  filter,  and  the  six  state  Kalman  filter,  Monte  Carlo 
average  error  magnitudes  for  all  three  estimators  were 
plotted  on  the  same  graphs.  Smoother  errors  during 
accelerations  were  consistently  the  largest.  This  is  well 
demonstrated  by  the  longitude  error  plot.  Figure  (8.1), 
which  shows  smoother  error  of  approximately  4xl0‘ 4  radians. 
This  equates  to  roughly  2.5  kilometers,  as  compared  to  76 
meters  for  the  six  state  filter's  position  errors. 

—— - 1  i - 1 - 1 — — i - r  ■  '  f  i  "i  “ 

NU  -  »«  Jt*t*  fJter 
—  -  eoept've  <iter 

.  =  aeoct^er  . . . 


I 

i 

i 

j 

-i 

l 

I 

->  ilO-1 
6.000 

TIME  (TUs) 

Figure  8.1.  Longitude  Error  Comparison,  1  Second  Interval 

The  adaptive  filter  showed  slightly  lower  heading 
errors.  Figures  (8.2)  and  (8.3),  but  had  performance  similar 
to  the  six  state  filter  for  the  remaining  states. 


o.ooc 


8-1 


The  distinct  spikes  in  Figure  (8.4)  demonstrate  the 
smoother's  superior  ability  to  follow  abrupt  changes  in 
acceleration,  but  the  six  state  Kalman  filter  had  the  lowest 
errors  overall.  The  attempts  at  adaptation  and  smoothing, 
then,  were  no  improvement  over  the  six  state  Kalman  filter. 
Appendix  D  presents  the  remaining  error  comparison  plots. 


§.,oc 


TIME  (TUs) 


Figure  8.4.  Intrack  Acceleration  Error  Comparison, 
1  Second  Data  Interval 
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IX.  Recommendations 


Attempts  at  adaptation  and  smoothing  were  no 
improvement  over  the  six  state  Kalman  filter.  Numerical 
imprecision  problems  could  be  lessened  by  rescaling  the 
problem  such  that  the  covariance  values  for  all  states  had 
similar  magnitudes.  This  would  allow  more  accurate 
covariance  matrix  inversion  and  possibly  improved  smoother 
performance.  Numerical  precision  for  all  of  the  estimators 
could  be  improved  by  using  a  factored  form  of  the  Kalman 
filter.  In  a  factored  form,  the  Cholesky  square  root  of  the 
covariance  matrix  is  propagated,  preventing  the  loss  of 
significant  digits  when  the  covariance  magnitude  is  much 
less  than  one. 

The  probability  weighting  adaptive  filter  could  be 
improved  by  using  the  exponential  of  the  unweighted  square 
of  the  residuals  in  the  probability  density  in  Equation 
(6.12).  This  further  enhances  quick  recognition  of  changes 
in  the  appropriateness  of  the  sub-filter  system 
models.  (l:b) 

Further  effort  to  validate  the  six  state  Kalman  filter 
could  focus  on  applying  the  filter  to  data  generated  from 
actual,  high-speed  aircraft  flights.  This  would  expose  any 
inadequacies  in  the  truth  model.  This  actual  data  could  be 
corrupted  by  mathematical  representations  of  atmospheric 
effects . 
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Singularities  exist  in  the  dynamics  equations  near  the 
poles  where  many  military  flights  are  likely  to  orbit.  A 
second  Kalman  filter  could  be  derived  using  a  coordinate 
system  90°  away  from  the  longitude/latitude  system.  This 
filter  could  be  used  when  the  TAV  flies  near  the  poles,  or 
it  could  be  combined  in  a  multiple  model  adaptive  filter 
much  the  same  as  the  four  and  six  state  filters  were 
combined  in  Chapter  VI. 

Finally,  although  the  adaptive  filters  presented  in 
this  thesis  gave  no  appreciable  improvement,  a  bank  of  six 
state  filters  (tuned  to  best  estimate  various  accelerations) 
could  still  be  tried  as  a  multiple  model  adaptive 
filter.  (6:8-2)  By  already  having  a  sub-filter  tuned  for 
various  accelerations,  multiple  "oodel  adaptive  filters 
generally  have  faster  response  to  changes  in  acceleration. 
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Appendix  A:  1  G  Covariance  and  Error  Plots 

This  appendix  provides  covariance  plots  for  the  six 
state  Kalman  filter,  the  probability  weighting  adaptive 
filter,  and  the  smoother.  Tables  xepresenting  initial 
conditions  are  presented  before  each  grouping  of  plots. 


Table  A.l.  Plight  Profile,  1  G  Accelerations 


Time  (sec) 

Time  (TU) 

Maneuver 

0-60 

0  -  .074 

Constant  Speed 

61  -  180 

.075  -  .223 

1  G  Intrack  Acceleration 

181  -  300 

.224  -  .372 

Constant  Speed 

301  -  420 

.373  -  .521 

1  G  Transverse  Accel . 

421  -  480 

.522  -  .595 

Constant  Speed 

I 


Table  A. 2.  Central  Trajectory  Initial  Conditions 


State 

Covariance 

X  =  0.0  rads 

P  =  1.25e-5  rads2 

6  =  0.0  rads 

P.c  =  1.25e-5  rads2 
oo 

h  =  0.7854  rads 

P  =  3.e-3  rads2 

hh 

V  =  0.5  DU/TU 

P  =  3 . e-2  (DU/TU)2 
vv 

at  =  0.0  DU/TU2 

P^  =  3 . 5e-2  (DU/TU2)2 

a  =0.0  DU/TU2 

P  =  2.5  (DU/TU2 ) 2 

T 

TT 

Figure  A.l.  Longitude  Covariance  and  Error,  1  G,  1  Second 
Data  Interval,  Six  State  Filter 
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Figure  A. 2.  Latitude  Covariance  and  Error,  1  G,  1  Second 
Data  Interval,  Six  State  Filter 
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Figure  A. 3.  Heading  Covariance  and  Error,  1  G,  1  Second 
Data  Interval,  Six  State  Filter 
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Figure  A. 4,  Velocity  Covariance  and  Error,  1  G,  1  Second 
Data  Interval,  Six  State  Filter 
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Figure  A.  7.  Longitude  Covariance  and  Error,  1  G 
10  Second  Data  Interval,  Six  State  Filter 
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Figure  A. 8.  Latitude  Covariance  and  Error,  1  G , 
10  Second  Data  Interval,  Six  State  Filter 
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Figure  A. 9.  Heading  Covariance  and  Error,  1 
10  Second  Data  Interval,  Six  State  Filter 
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Figure  A. 10.  Velocity  Covariance  and  Error,  1 
10  Second  Data  Interval,  Six  State  Filter 
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10  Second  Data  Interval,  Six  State  Pilter 
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Figure  A. 13.  Longitude  Covariance  and  Error,  1  G, 

1  Second  Data  Interval,  Probability  Weighting  Adaptation 
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Figure  A. 14.  Latitude  Covariance  and  Error,  1  G, 

1  Second  Data  Interval,  Probability  Weighting  Adaptation 
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Figure  A. 15.  Heading  Covariance  and  Error,  1  G, 

1  Second  Data  Interval,  Probability  Weighting  Adaptation 
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Figure  A. 16.  Velocity  Covariance  and  Error,  1  G, 

1  Second  Data  Interval,  Probability  Weighting  Adaptation 
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Figure  A. 19.  Longitude  Covariance  and  Error,  1  G, 
Second  Data  Interval,  Probability  Weighting  Adaptation 
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Figure  A. 21.  Heading  Covariance  and  Error,  1  G,  10  Second 
Data  Interval,  Probability  Weighting  Adaptation 


Figure  A. 22.  Velocity  Covariance  and  Error,  1  G, 

10  Second  Data  Interval,  Probability  Weighting  Adaptation 
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Figure  A. 25.  Longitude  Covariance  and  Error,  1  G, 
1  Second  Data  Interval ,  Smoother 
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Figure  A. 26.  Latitude  Covariance  and  Error,  1  G, 
1  Second  Data  Interval ,  Smoother 
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Figure  A. 29.  a ^  Covar4 ^nce  and  Error, 
1  Second  Data  Interval ,  Smoother 
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Figure  A. 30.  aT  Covariance  and  Error, 
1  Second  Data  Interval ,  Smoother 
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Figure  A. 33.  Heading  Covariance  and  Error,  1  G 
10  Second  Data  Interval ,  Smoother 
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Figure  A. 34.  Velocity  Covariance  and  Error,  1  G 
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Table  A. 3.  North  Trajectory  Initial  Conditions 
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Figure  A. 40.  Velocity  Covariance  and  Error,  1  G,  1  Second 
Interval,  North  Trajectory,  Six  State  Filter 
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Figure  A. 41.  af  Covariance  and  Error,  1  G,  1  Second 
Interval,  North  Trajectory,  Six  State  Filter 
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Figure  A. 42.  aT  Covariance  and  Error,  1  G,  1  Second 
Interval,  North  Trajectory,  Six  State  Filter 


Table  A. 4.  East  Trajectory  Initial  Conditions 


State 


=  1.0472  rads 
=  0.1745  rads 
=  1.5708  rads 
=0.5  DU/TU 
t  =  0.0  DU/TU2 
=0.0  DU/TU2 


Covariance 

pxx 

=  1.25e-5  rads2 

P56 

=  1 . 25e-5  rads2 

P 

=  3.e-3  rads2 

hh 

P»v 

=  3 . e-2  (DU/TU)2 

p 

1 1 

=  3 . 5e-2  (DU/TU2)2 

p 

=  2.5  (DU/TU2)2 

TT 
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Figure  A. 47.  aj  Covariance  and  Error,  1  G,  1  Second 
Interval,  East  Trajectory,  Six  State  Filter 
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Figure  A. 48.  aT  Covariance  and  Error,  1  G,  1  Second 


Interval,  East  Trajectory,  Six  State  Filter 
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Appendix  B:  9  G  Covariance  and  Error  Plots 

Chapter  4  applied  the  six  state  Kalman  filter  to  a  9  G 
flight  profile.  The  covariance  plots  for  the  one  and  ten 
second  data  interval  filters  are  presented  below. 

Table  B.l.  Flight  Profile,  9  G  Accelerations 


Time  (sec) 

Time  (TU) 

Maneuver 

0-60 

0  -  .074 

Constant  Speed 

61  -  180 

.075  -  .223 

9  G  Intrack  Acceleration 

181  -  300 

.224  -  .372 

Constant  Speed 

301  -  420 

.373  -  .521 

9  G  Transverse  Accel . 

421  -  480 

.522  -  .595 

Constant  Speed 

Table  B.2.  Central  Trajectory  Initial  Conditions 


State 

Covariance 

X  =  0.0  rads 

P  =  1.25e-5  rads2 

8  =  0.0  rads 

P.c  =  1.25e-5  rads2 

Ck> 

h  =  0 .7854  rads 

P  =  3.e-3  rads2 

tih 

V  =  0.5  DU/TU 

P  =  3 . e-2  (DU/TU)2 
vv 

=  0.0  DU/TU2 

P  =  3.5e-2  (DU/TU2)2 
ii 

a  =  0.0  DU/TU2 

P  =  2.5  (DU/TU2)2 

T 

TT 
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Figure  B.7.  Longitude  Covariance  and  Error,  9  < 
10  Second  Data  Interval,  Six  State  Filter 


Figure  B.8.  Latitude  Covariance  and  Error,  9  G 
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Figure  B.9.  Heading  Covariance  and  Error,  9  G 
10  Second  Data  Interval,  Six  State  Filter 
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Figure  B.10.  Velocity  Covariance  and  Error,  9  G 
10  Second  Data  Interval,  Six  State  Filter 
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To  show  the  consistency  in  state  estimation  for  the  six 
state  Kalman  filter.  Chapter  4  presented  four  error 
statistics  plots.  All  six  states'  plots  for  both  the  one 
and  ten  second  interval  filters  are  presented  below. 

Table  C.l.  Central  Trajectory  Initial  Conditions 


State 

Covariance 

x  =  0.0  rads 

=  1.25e-5  rads2 

6  =  0.0  rads 

=  1 . 25e-5  rads2 

h  =  0 . 7854  rads 

P  =  3.e-3  rads2 

hh 

V  =  0.5  DU/TU 

P  =  3 . e-2  (DU/TU)2 
vv 

aj  =  0.0  DU/TU2 

P  =  3 . 5e-2  (DU/TU2)2 

aT  =  0.0  DU/TU2 

Ptt  =  2.5  (DU/TU2)2 

TIME  (TUs) 


Figure  C.3.  Monte  Carlo  Heading  Error  Statistics,  1  G 
1  Second  Data  Interval,  Six  State  Filter 
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Figure  C.4.  Monte  Carlo  Velocity  Error  Statistics,  1  G 


1  Second  Data  Interval,  Six  State  Filter 
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Figure  C.5.  Monte  Carlo  a}  Error  Statistics,  1  G, 
1  Second  Data  Interval,  Six  State  Filter 
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Figure  C.6.  Monte  Carlo  aT  Error  Statistics,  1  G 
1  Second  Data  Interval,  Six  State  Filter 
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10  Second  Data  Interval.  Six  State  Filter 


Appendix  D: 


Chapter  8  compared  the  six  strte  Kalman  filter,  the 
probability  weighting  adaptive  filter,  and  the  smoother  via 
plots  of  the  average  magnitude  of  their  errors.  All  of  the 
error  comparison  plots  for  the  one  and  ten  second  data 
interval  estimators  are  presented  below. 
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Figure  D.l.  Longitude  Error  Comparison,  1  Second  Interval 
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Figure  D.4.  Velocity  Error  Comparison,  1  Second  Inter 


Figure  D.5.  Error  Comparison,  1  Second  Interval 
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re  D.6.  aT  Error  Comparison,  1  Second  Interval 


D.7.  Longitude  Error  Comparison,  10  Second  Interval 
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Figure  D.12. 


a 


T 


Error  Comparison, 


10  Second  Interval 


D-7 


Bibliography 


1.  Maybeck,  Peter  S.  in  private  conversations,  Sep  90. 

2.  Maybeck,  Peter  S.  Stochastic  Models .  Estimation .  and 
Control  (Volume  1),  San  Diego:  Academic  Press,  Inc., 
1979. 

3.  Maybeck,  Peter  S.  Stochastic  Models ,  Estimation ,  and 
Control  (Volume  2),  New  York:  Academic  Press,  Inc., 
1982. 

4.  Osedacz,  Capt  Richard  M.  Orbit  Determination  of 
Sunl ight  I 1 luminated  Objects  Detected  by  Overhead 
Platforms.  MS  Thesis,  AFIT/ GA/ENY/89J-3 .  School  of 
Engineering,  Air  Force  Institute  of  Technology  (AU), 
Wright-Patterson  AFB  OH,  June  1989. 

5.  Wiesel ,  William  E.  Lecture  Notes  for  MC  7.31,  Modern 
Methods  of  Orbit  Determination .  School  of  Engineering, 
Air  Force  Institute  of  Technology  (AU), 

Wright-Patterson  AFB  OH,  1990. 

Ziegler,  Capt  David  W.  Tracking  a  Hypersonic  Aircraft 
from  a  Space  Platform.  MS  Thesis,  AFIT/GA/ENY/89D-7 . 
School  of  Engineering,  Air  Force  Institute  of 
Technology  (AU),  Wright-Patterson  AFB  OH,  December 
1989. 


6. 


Vita 

Captain  Kenneth  A.  Gotski 

He  graduated  from  Riverside-Brookfield 
Township  High  School  in  Riverside,  Illinois  in  1982  and 
attended  the  D.S.  Air  Porce  Academy,  graduating  in  May  1986 
with  a  Bachelor  of  Science  in  Astronautical  Engineering.  He 
was  assigned  to  the  Upper  Stages  Program  Office,  Los  Angeles 
Air  Force  Base,  California,  as  a  software  engineer  for  the 
Inertial  Upper  Stage  (IUS).  Initially  he  managed  the 
independent  verification  and  validation  of  IUS  flight 
software.  He  was  chosen  to  help  write  the  requirements  for 
the  development  of  an  IUS  interplanetary  capability  ,  and 
was  later  selected  as  the  overall  software  manager  for 
flight  related  software  production  and  testing  on  all  DoD 
and  National  Aeronautics  and  Space  Administration  missions. 
In  May  1989  he  entered  the  school  of  Engineering,  Air  Force 
Institute  of  Technology. 


REPORT  DOCUMENTATION  PAGE 


1 

OMb  \  -j* 

i 

- 1 

I  AGENCY  uSt  OMY 


A  T-T.E  AND  SUE*.’.  £ 

ADAPTIVE  FILTERING  AND  SMOOTHING  FOR  TRACKING  A 
HYPERSONIC  AIRCRAFT  FROM  A  SPACE  PLATFORM 


Kenneth  A.  Gotski,  Captain,  USAF 


7  PERFOWNC  ORGANIZATION  NAVE  '  AM  ADDRESS  Ef. 

Air  Force  Institute  of  Technology,  WPAFB  OH  45433-6583 


3  REPORT  TYPE  AND  DA’ES  COVERED 

Master's  Thesis 


S  FUNDING  NUWBE 


8  PERFORMING  ORGAN  ;  • 
report  nume:; 

AFIT/GA/ENY/9 0D- 6 


v;  SPONSORING  VTN'V-V 
AGENO  REPOR'  N.  S'  L'  ■ 


Approved  for  public  release;  distribution  unlimited 


l  Thus  study  took  a  previously  developed  six  state  Kalman  filter  (designed  for 
1  space-based  tracking  of  a  hypersonic  transatmospheric  vehicle) ,  tuned  it,  and 
!  performed  a  Monte  Carlo  analysis.  Three  multiple  model  adaptive  filters  were  then 
developed,  with  sub-filters  designed  for  quiescent  periods  and  periods  with 
j  apparent  acceleration.  Next,  a  smoother  was  developed  using  the  six  state  filter  as 
the  forward  filter  and  a  form  of  that  same  filter  as  the  backward  filter.  The 
smoother  and  all  of  the  above  filters  were  compared  for  their  ability  to  nost 
accurately  estimate  the  transatmospheric  vehicle's  state,  with  special  emphasis  on 
the  acceleration  states.  This  emphasis  was  motivated  by  a  desire  to  evaluate  the 
Kalman  filter's  usefulness  as  a  real-time  intelligence  gathering  tool.  From  the 
data  generated,  it  was  concluded  that  neither  the  adaptive  filters  nor  the  smoother 
improved  upon  the  performance  of  the  six  state  Kalman  filter. 


1  S  U  P  ;  £  Z  "  T  i  K  V  S 

Kalman  Filtering,  Tracking,  Adaptive  Filters,  Smoothing  Data 


i :  secjR  t*  class  fcat:on 

OF  RfOQR' 

Unclassified 


■e  SEC  JR  *»  Classification 

’9  SECURITY  CLASST  CA’iCN 

VC  LINMAnON  OF  ABSTRACT  1 

0>  This  PAGE 

OF  ABSTRACT 

1 

t 

Unclassified 

Unclassified 

UL 

